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Bearing-Based Formation Maneuvering 

Shiyu Zhao and Daniel Zelazo 


Abstract —This paper studies the problem of multi-agent 
formation maneuver control where both of the centroid and 
scale of a formation are required to track given velocity 
references while maintaining the formation shape. Unlike the 
conventional approaches where the target formation is defined 
by inter-neighbor relative positions or distances, we propose 
a bearing-based approach where the target formation is de¬ 
fined by inter-neighbor bearings. Due to the invariance of 
the bearings, the bearing-based approach provides a natural 
solution to formation scale control. We assume the dynamics 
of each agent as a single integrator and propose a globally 
stable proportional-integral formation maneuver control law. 
It is shown that at least two leaders are required to collaborate 
in order to control the centroid and scale of the formation 
whereas the followers are not required to have access to any 
global information, such as the velocities of the leaders. 

I. Introduction 

In the conventional approaches to distributed multi-agent 
formation control, the target formation is defined by either 
inter-neighbor relative position or distance constraints. In 
recent years, there has been a growing research interest 
in the bearing-based approach where the target formation 
is constrained by inter-neighbor bearings. The existing 
works on bearing-based formation control focused mainly 
on distributed stabilization of static target formations using 
bearing-only [ 1 ]—[7] or relative position measurements [8]- 
[11], In this paper we focus on distributed tracking control 
of maneuvering target formations whose centroid and scale 
track given velocity references while the formation shape is 
maintained as desired. 

In our previous work [11], we proposed a linear bearing- 
based control law to stabilize static target formations in 
arbitrary dimensions. When applied to the maneuvering 
case where the leaders have nonzero constant velocities, 
the control law proposed in [11] would result in constant 
tracking errors. In order to eliminate the tracking errors, in 
this paper we adopt a proportional-integral (PI) formation 
control scheme, which has also been applied to solve the 
problem of distance-based formation maneuver control [12], 
[13], The basic idea of the PI control scheme is to treat the 
constant leader velocities as an input disturbance and the 
impact of the disturbance can be eliminated by the integral 
action. By following the PI control scheme, the stabilization 
control law in [11] can be viewed as a proportional control 
and an integral term of the proportional control can be added 
to obtain an effective formation maneuver control law. In this 
paper, we show that there must exist at least two leaders and 
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the leaders must collaborate to control the collective motion 
of the entire formation. 

One advantage of the proposed bearing-based formation 
control law is that it provides a natural solution to formation 
scale control. Formation scale control is a practically useful 
technique. By adjusting the scale of the formation, the agents 
are able to dynamically respond to the environments includ¬ 
ing, for example, avoiding obstacles. The relative position 
and distance based approaches have been applied to solve 
the formation scale control problem [14], [15]. But since 
the inter-neighbor relative positions or distances are not 
invariant to the formation scale, the two approaches lead to 
complicated estimation and control scheme [14], [15]. As a 
comparison, the bearing-based approach provides a simple 
solution to formation scale control due to the invariance 
of the inter-neighbor bearings to the formation scale. As 
shown in this paper, by assigning appropriate velocities 
to the leaders, the scale of the formation can be adjusted 
continuously while the formation shape can be maintained 
as desired. 

II. Notations and Preliminaries 

In this section, we present the notations and preliminaries 
to the bearing rigidity theory that will be used throughout 
the paper. 

A. Notations 

For any nonzero vector x £ W 1 (d > 2), define the 
orthogonal projection operator P : —> R. dxd as 


For notational simplicity, we denote P x = P(x). Note that 
P x is an orthogonal projection matrix that geometrically 
projects any vector onto the orthogonal compliment of x. 
It can be easily seen that P x is positive semi-definite and 
satisfies P x = P x , P x = P x , and Null(P a ,) = span{x}. 

Denote I n £ R raxn as the identity matrix, and 1„ = 
[1,..., 1] T € R”. Let Null(-) be the null space of a matrix. 
Let || • || be the Euclidian norm of a vector or the spectral 
norm of a matrix, and ® be the Kronecker product. 

B. Preliminaries to Bearing Rigidity Theory 

Bearing rigidity theory provides a fundamental tool for 
the analysis of bearing-based formation control problems. 
The results presented in the following can be found in [7], 
Consider a set of points {p;}” =1 in R d (n > 2 and d > 
2) and assume no two points are collocated. Denote p = 
[pf,... ,Pn] T G R dn . Let Q = (V, £) be an undirected graph 



that consists of a vertex set V and an edge set £ C V x V. 
Let n— | V| and m — \£\. The set of neighbors of vertex i is 
denoted as A/* = {j £ V : (i, j) £ £}. A formation, denoted 
as G(p), is a graph G with vertex i in the graph mapped to 
the point p t for all i £ V. 

For a formation G(p), define the edge vector and the 
bearing, respectively, as 

e-ij = Pj - Pi, gij = eij/WeijW, V(i, j) £ £. 

The bearing g l3 is a unit vector. Note e.j 7 = —ep and g t j = 
—gji. Assign a direction to each edge in G and express the 
edge vector and the bearing for the kth directed edge in 
the oriented graph as = pj — pu gk — e fc/|| e fc|U e 
{1 respectively. Define the bearing function Fg : 

R dn R dm as 

FB(p)±\gL-,&] T - 

The bearing function describes all the bearings in the forma¬ 
tion. The bearing rigidity matrix is defined as the Jacobian 
of the bearing function, 

r b {p) 4 dF ^ € R dmxdn . 

Let Sp be a variation of p. If Rs{p)5p = 0, then 5p is 
called an infinitesimal bearing motion of G(p). A formation 
always has two kinds of trivial infinitesimal bearing motions: 
translation and scaling of the entire formation. The next 
definition is one of the most important concepts in bearing 
rigidity theory. 

Definition 1 (Infinitesimal Bearing Rigidity). A formation 
is infinitesimally bearing rigid if all the infinitesimal bearing 
motions of the formation are trivial. 

The following are necessary and sufficient conditions for 
infinitesimal bearing rigidity. 

Theorem 1 ([7]). For any formation Q (p), the following 
statements are equivalent: 

(a) Q(p) is infinitesimally bearing rigid; 

(b) G(p) can be uniquely determined up to a translation and 
a scaling factor by the inter-neighbor bearings; 

(c) rank(i?s) = dn — d — 1; 

(d) NuII(-Rb) = span{l„ 0 I d ,p}- 

III. Problem Statement of Bearing-Based 
Formation Maneuvering 

Consider a formation of n agents in R d (n > 2, d > 2). Let 
Pi £ R d and ig £ R d be the position and velocity of agent i £ 
V = {1,..., n}. Suppose the velocity of the first ng agents 
are given. Then the first ni agents are called leaders and the 
rest n f agents are called followers. Note 0 < ne < n and 
ni+rif = n. Let Vt = {1,..., n{\ and V/ = {ne + 1,... ,n} 
be the index sets of the leaders and followers, respectively. 
The dynamics of the leaders and followers are given by 

Pi(t)=v*(t), 

Pi( t ) = v i(t)i * e V/, 


where {v*(t)}iev e are the velocity references assigned to 
the leaders, and {fi(f)}ieV/ are the control inputs to be 
designed for the followers. Denote pe = [pf,... ,p^J T , 
Pf = \Pne+i’ ■ ■ - ’PnV’ and P = \pj ■ Furthermore, 
denote v* t = [K) T , ..., «J T ] T , v f = [< +1 ,..., v^] T , 
and v = [(V() T , vJ] T . 

Suppose the underlying information flow among the agents 
can be described by a fixed and undirected graph Q = (V,£). 
If (i,j) £ £, then agents i and j can obtain the relative 
positions of each other. Suppose a desired formation shape 
is defined by the constant inter-neighbor bearing constraints 
{dtj}(i,j)e£ ■ The problem of bearing-based formation ma¬ 
neuvering is stated as below. 

Problem 1 (Bearing-Based Formation Maneuvering). Con¬ 
sider a formation G(p) where the velocities of the leaders are 
assigned as {r)*(f)}igvr Design the control input for each 
follower Vi(t) (i £ Vf) based on the relative position mea¬ 
surements {pifit) — Pj(t)} : jc- J \f i such that the inter-neighbor 
bearings converge to the desired values, i.e., gij(t) —» g* 3 
for all (i, j) £ £ as t -A oo. 

When the velocity of each leader is zero. Problem 1 would 
become the bearing-based formation stabilization problem 
studied in [11], 

In Problem 1 the formation is required to converge to 
a target formation that is jointly determined by the inter¬ 
neighbor bearings and the leaders. This target formation is 
formally defined below. 

Definition 2 (Target Formation). Let G{p*{t)) be the target 
formation that satisfies the following constraints for all t > 
0 : 

(a) Bearing: (p*(t)-p*{t))/\\p*(t)-p*(t)\\ = gL,\/(i,j) £ 

£, 

(b) Leader: p*(t) =Pi(t),\/i £ Vg. 

Since the leaders have nonzero velocities, the centroid and 
scale of the target formation are time-varying. The shape 
of the target formation is, however, fixed since the bearing 
constraints are constant. Based on the notion of the target 
formation G(p*(t)), Problem 1 can be equivalently stated 
as designing a control law such that the formation p(f) can 
converge to the target formation p*(t), i.e., pfit) p*(t) 
for all * £ Vf as t —> oo. 

One key problem that follows the definition of the target 
formation is whether the target formation exists and is 
unique. In fact, this problem is equivalent to the localizability 
problem in bearing-only network localization [16]. As shown 
in [16], a formation can be uniquely determined by the 
bearings and the leaders if and only if the formation is 
localizable. A variety of conditions for localizability have 
been proposed in [16]. One useful sufficient condition is 
that a formation would be localizable if the formation is 
infinitesimally bearing rigid and has at least two leaders. 
This sufficient condition is intuitively easy to understand. 
Specifically, if the formation is infinitesimally bearing rigid, 
then it can be uniquely determined up to a translation and 
a scaling factor by the bearings. The translation and scaling 



ambiguity can be further eliminated by the introduction of 
at least two leaders. Then the formation can be fully and 
uniquely determined. Due to space limitations, we omit the 
details and simply make the following assumption. 

Assumption 1. The target formation G(p*(t)) is infinitesi¬ 
mally bearing rigid and has at least two leaders. 

The mathematical condition implied by Assumption 1 
will be given later (see Lemma 2). It is worth noting 
that the infinitesimal bearing rigidity is merely sufficient 
but not necessary to ensure the existence and uniqueness 
of the target formation. For both necessary and sufficient 
conditions, please see [16], 

IV. Proposed Control Law 
and Convergence Analysis 

In this section we first propose a distributed PI control 
law to solve Problem 1 and then prove the global formation 
stability under the control law. 

A. A Distributed PI Control Law 

For each follower, the proposed control law is 

Pi(t) - Y PgfiPi^) ~ Pj(t )) 

jeMi 

s. 

proportional 

~kl f Y P 9*j(Pi( T ) -Pj( r )) dT > i € Vf, (1) 

Ja je M 

--^-' 

integral 

where P g - = Id — g*j{g*j ) T , and kp and kj are positive 
constant control gains. Control law (1) is distributed because 
the control of each agent only requires the relative positions 
of its neighbors. The control law consists of a proportional 
term and an integral term. When ki = 0, the control law 
would become the one proposed in [11], If the velocities 
of the leaders are zero, the proportional control alone is 
able to stabilize the target formation. But if the velocities 
of the leaders are nonzero, the integral control is required to 
eliminate the steady state tracking error. 

By defining a new state for the integral term, control law 
(1) can be rewritten as 

Pitt) = -kp Y PgljiPitt) -Pitt)) ~ 

£i(t) = Y P^iPitt) -Pj(*))> *gV/. ( 2 ) 

jeM 

We next derive the matrix expression of control law (2), 
which will be useful for the convergence analysis. Let £ £ 
R dnxdn b e a matrix with the ij th block submatrix as 

{ \P\ij = 0 dxdi i 7^ j- (L j) £ 

= —Pgtj > * ^ ii (*> j) G £, 

[£\u = Mi Pgfi ’ i — jfi £ V- 

The matrix C can be interpreted as a matrix-weighted graph 
Laplacian. We call C the bearing Laplacian since it carries 


the information of both the underlying graph and the bearings 
of the formation. Partition C into the following form 


r — kite. 

[ Lit 

where C u G R dn ‘ xdn f C if = £ 


C ff 

C ff 

ft " 


X dn 


f, and Cff G 


dnfxdnf' xhen, it is straightforward to see that the matrix 
expression of control law (2) is 


Pf{t) = -kp {£ffPf(t ) + C f m{t)) - h£(t), 
i(t) = CffPfit ) + C f tPi{t), (3) 

where ^(f) = [f ne+1 (t) T ,..., £ n (t) T } T G R dn f . 


B. Convergence Analysis 

Define the tracking error for the followers as 

S(t)=Pf(t)-p* f (t), (4) 

where Pf(t) is the real position of the followers and Pf(t) 
is the time-varying expected position of the followers in the 
target formation. The aim of the convergence analysis is to 
show that 6{t) converges to zero. To that end, we need to 
first calculate p*f(t). The following two results on the bearing 
Laplacian are useful. 

Lemma 1. Any formation G(p) that satisfies the bearing con¬ 
straints {g*j}(i,j)e£ satisfies Cp = 0 and CffPf+Cfipi = 0. 

Proof. Note 


Cm 

Ctf 

Pt 

C f i 

Pff . 

. Pf . 




By the elementwise expression of Cp, it is obvious that Cp = 
0 if G(p) satisfies the bearing constraints, i.e, (pj— Pi)/\\Pj — 
Pill =9*j■ By the partitioned block matrix expression of Cp, 
it can be seen that Cp = 0 implies £//p/ + Cft,pi =0. □ 

Lemma 2 ([16]). The matrix Cff is positive definite if 
Assumption 1 holds. 

Since the target formation p* (t) satisfies the bearing con¬ 
straints, it follows fromLemma 1 that £ f fp*f(t)+C fePe(t) = 
0. Furthermore, since Cff is positive definite by Lemma 2, 
we have 


P}(t) = -C~f)C fm (f). (5) 

Substituting (4) and (5) into (3) yields 

§(t) = —kpC ff S(t) - &i£(f) + Cj}C fe v}(t), 

i(t) = (6) 


The 6- and ^-dynamics given above can be written in a 
compact form as 


' 6 ' 


-k v Cff 

f 


' (5 ' 

+ 

CffCft 

. i. 


Pff 

0 


. c _ 


0 


A 


v* e (t). 


(7) 



Lemma 3. The state matrix A in (7) is Hurwitz for any 
kp , ki > 0. 


Proof. Suppose A is an eigenvalue of A. Then, 

det(AI — A) = det 


k\I 

XI 


XI + kpTff 
~ C ff 

— det (A 2 / -j- kpXjCff + k\Cff) 
A 2 / 


= det I (/cpA + k{) 


fcpA + ki 


+ C 


ff 


As a result, det (A/ — A) = 0 implies either A = —k\/kp < 0 
or 

A 2 

fcpA + k\ 

where cr is the eigenvalue of £//. Since Cff is symmetric 
positive definite, we know cr is positive and real. The solution 
to the above equation can be easily calculated and it can be 
shown that A < —k\jkp <0. □ 


Since A is Hurwitz, system (7) is stable. When v\(f) is 
time-varying, the followers are not able to perfectly track 
the leaders. The fundamental reason is that the followers do 
not have access to the time-varying velocities of the leaders. 
When v\f) is constant, the tracking error will globally 
converge to zero due to the integral action. 

Theorem 2 (Global Convergence). When Ve(t) = v* e is 
constant, S(t) and £(f) exponentially and globally converges 
to S(oo) = 0 and £(oo) = CjjCftVp/ki, respectively. As a 
result, 

Pf(t ) -> P*f(t) = ~CjfC fe pe(t), 

p f {t) ->«} = 

as t —> oo. 

Proof. Since A is Hurwitz and v| is constant, 5(f) and £(t) 
globally and exponentially converge to the steady state values 
of 5 and £ By letting <5 = 0 and £ = 0, we can easily 
verify that the steady state values are <5(oo) = 0 and £(oo) = 
CfjCfpyl/k], It follows from 5(t) —t 0 and 5(t) —► 0 that 
Pff) -f P*ff) and p f (t) y p)(t ) = v* f . □ 


By substituting £(oo) = CjjCftVf/ki back into (6), it 
can be seen that the integral term £ finally eliminates the 
impact of the “disturbance” v|. 


C. Centroid and Scale Dynamics 

We next study how the leaders should move in order 
to realize the desired translational and scaling formation 
maneuvers under the action of the proposed control law. In 
order to do that, we need to first define the centroid and scale 
of a formation and then analyze their dynamics. Define the 


centroid c(p*(t)) and the scale s(p*(t)) of p*(t) as 

c(p*f)) = 1 ^2p*(t) = 1 (1„ (g )I d ) T p*(t), 
iev 

s(p*f)) 4 ./-^Ib*(i)-c(p*)|| 2 
V iev 

= -^||p*(t)-l n ® C (p*)||. 

vn 


Proposition 1 (Translational Maneuvering). If the velocity 
of each leader is constant and satisfies 

v* = v c , i e Vi, 

where v c £ is a common velocity, then 

c(p*(t)) = w c , s(p*(t)) = 0, 

which means the target formation p* ( t ) moves at the common 
velocity while the scale is fixed. 


Proof. Since v*(t) = v c ,Vi £ Vi, we have v%(t) = l n< ® 
v c . It follows from £(l n <g> v c ) = 0 that Cft(l nt ® v c ) + 
Cff(l n , (g) v c ) = 0. As a result, 

Vf = -CjjCfiVi = l nf ® V c . 

Consequently, p* = [(u|) T , (v)) T ] T = l n (g>v c . Substituting 
p* into c(p*) and s(p*) gives 


c(p*) 

s(p*) 


1 

n 


(In <S> Id) T p* 


1 

n 


(l„(g J d ) T (l„(gv c ) 


1 (p - l n ® c(p*)) T 
Up - 1 n <g> c(p*) || 
1 (p- l n ®c(p*)) T 
yfn ||p- 1„ (g)c(p*)|| 


(In ® V c ) = 0. 


= V 


ct 


□ 


Proposition 2 (Scaling Maneuvering). If the velocity of each 
leader is constant and satisfies 


P* it) - c(p*) 


ib*w-c(p*)ir 


i £ Vi, 


( 8 ) 


where oti £ K is constant and satisfies oti/\\p*(t) — c(p*)\\ = 
a i/\\P*jf) - c(p*)|| for all i,j £ Vt, then 


c(jp*(t)) = 0, 


s(P*(t)) = sgn(ctj) 



oa 


which means the scale of the target formation p*(t ) is 
continuously varying while the centroid is fixed. 


Proof. Since a*/||p*(f) - c(p*)|| = aj/\\p*(t) - c(p*)\\ for 
all i,j £ Vi, there exists k(t) such that 

= Ht)\\p*f) - c (p*)ll 

and hence v* = k(t)(p*(t ) — c(p*)) for all i £ Vt. Then, v\ 
can be expressed as v\ = k(t)(p* — l n{ <8>c(p*)). It follows 
from C(p* - l n <g> c(p*)) = 0 that Cft(p\ - l ne <g) c(p*)) + 



Cffip'f — l nf (g) c(p*)) = 0. As a result, 

v* f = -CjjCfev} = k(t)(p*f - l nj <g> c(p*)). 

Consequently, p* = [(v* t ) T , ( v* f ) T } T = k(t)(p* -l„(g>c(p*)). 
Substituting p* into c(p*) and s(p*) gives 


1 


c(p*) = -(l n ® Id) T p* 

n 

= -(l n ® IdViP* - In ® C(p*))k(t ) = 0, 
n 


and 


■/ *N = 1 (P*-1„«C(P*)) T 

y/n lb* - In ® c(p*) || P 


w.s l (P^ 1 n®c{p)) T , 

= k ( t )~^l FT- 1 <> t *UI (P -1 n®c(jp)) 

yjn ||p* - In ® c(p*)|| 

= k(t)-^=\\p* - 1„ ® c(p*)|| 

\/n 

= Kt)J-J2\\p*(t) - c(p*)|| 2 

V iev 


= 


\ 




□ 


In Proposition 2, if a, > 0, the velocity of each agent is 
pointing from the fixed centroid to the agent and hence the 
formation scale dilates; otherwise, if a* < 0 the formation 
scale shrinks. It should be noted that v* given in (8) is 
constant though p*(t) is time-varying. 

When the velocity of the leaders is a linear combination of 
a translational and a scaling term, both the centroid and the 
scale of the formation will be time-varying. Denote c{p(t)) 
and s(p(t)) as the centroid and the scale of the real formation 
p(t), respectively. By combining Theorem 2, Propositions 1, 
and 2, we obtain the following theorem. 


Theorem 3. Under Assumption 1, if the velocity of each 
leader is constant and there exist constant v c £ and 
^ £ I such that v* can be decomposed to 


= v c + a,; 


lb* CO 


where ai satisfies ct,/||p*(i) 
for all i,j £ Vf. As a result, 


~ c(P*) 

-c(p*)|| 

c(p*) II = 


Vi £ Vt, 
Vj/WPjit) 


(9) 
c(p*) || 


c{p*(t)) 


s(p*(t)) = sgn(ai) 



Furthermore, c(p(t)) and s(p(t)) globally converge to 
c(p*(t)) and s(p*(t)), respectively. 


Proof Since the target formation p*(t) satisfies the bearing 
constraints, it follows from Lemma 1 that Cp* (t) = 0, which 
implies Cv*(t) = 0. Since the bearing constraints imply 
infinitesimal bearing rigidity, then Null(£) = span{l„ (g> 
Id,p*}- As a result, if v* is constant, it can always be 
expressed as a linear combination of l n 0 /,/ and p* — l n 0 


c(p*). Therefore, equation (9) holds. The rest of the theorem 
directly follows from Theorem 2, Propositions 1, and 2. □ 

Two remarks on Theorem 3 are given below. Firstly, in 
order to achieve the desired translational or scaling maneu¬ 
vering, the leaders must collaborate and share some global 
information like a common velocity and the centroid of the 
formation. Secondly, v* given in (9) is constant because the 
unit vector {p*(t) — c(p*))/\\p*(t) — c(p*)|| is invariant to 
translational and scaling maneuvers though p* (t) is not. 

V. Simulation Examples 

Figure 1 and Figure 2 give two comprehensive examples 
to demonstrate that the proposed control law can control 
the formation scale and translation to perform sophisticated 
maneuvers such as moving the formation through a narrow 
passage while maintaining the desired formation shape. In 
each example, the target formation is infinitesimally bearing 
rigid and has two leaders. The leader velocities are piecewise 
constant. In the two examples, the leaders have a common 
forward velocity such that the entire formation always moves 
forward. In order to adjust the formation scale, the leaders 
will have an additional velocity to move toward or away 
from each other to adjust the distance between them. It 
is also worthwhile mentioning that although the tracking 
errors converge to zero only when the leader velocities are 
constant, the proposed control law can still give satisfactory 
performance in the cases where the leader velocities are 
piecewise continuous. 

VI. Conclusion 

This paper studied the problem of bearing-based formation 
maneuver control in arbitrary dimensions. A distributed PI 
control law has been proposed and its global stability has 
been proved. It was shown that under the proposed control 
law the leaders can collaborate to control the translation and 
scale of the formation. In this paper, we only considered 
the case where the underlying sensing graph is undirected. 
Directed cases will be studied in the future. 
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(b) Leader velocity commands (both leaders, red and blue, have the 
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Fig. 1: A 2D example to demonstrate the formation maneuver through a 
narrow passage in the plane. 
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